
clc;
clear;
r = 999;
h0 = 0.001;
h = 0.001;

for i = 1 : 4000
 T(i) = 0.001*(i-1);
 v(i) = sin(1*T(i));
end

[x1, x2, u] = td(v, r, h0, h);

figure
plot(T(:),v(:),'*-');
hold on;
grid;
plot(T(:),x1(:),'*-');
 
figure;
plot(T(:),x2(:),'*-');
grid;

figure;
plot(T(:),u(:),'*-');
grid;